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GP-303502 

VEHICLE STABILITY ENHANCEMENT CONTROL AND METHOD 
TECHNICAL FIELD 

[0001] The present invention relates generally to vehicles and vehicle 

stability control systems. The present invention relates more particularly to vehicle 
stability control systems comprising a vehicle side-slip feedback control. 

BACKGROUND OF THE INVENTION 

[0002] There are two motions that take place when a vehicle turns. The first 

motion is a turning motion called yaw motion. Yaw motion takes place as the 
vehicle body spins around an imaginary vertical axis that is substantially 
perpendicular to the ground. The second motion is a lateral sliding motion called 
side-slip motion. Side-slip motion occurs in the same direction as the turn or in the 
opposite direction depending on the speed of the vehicle. 

[0003] A desired yaw rate and a desired side-slip velocity are determined 

based on the speed of a vehicle and the position of the steering wheel. The desired 
values correspond to the expected yaw rate and side-slip velocity when a vehicle is 
traveling on a dry and clean surface. A driver may sense instability when either the 
actual yaw rate or side-slip velocity, or both of them, significantly exceeds the 
expected value. 

[0004] In a vehicle stability enhancement system, the actual yaw rate and 

side-slip velocity of the vehicle are compared to their desired values. Corrective 
action is taken when either of their desired values is exceeded by a predetermined 
threshold. When a significant discrepancy exists between either the desired yaw 
rate and the actual yaw rate or the desired side-slip velocity and the actual side-slip 
velocity of the vehicle, or both of them, it is likely the road conditions necessitate 
vehicle stability enhancement. 

[0005] Current methods of vehicle stability enhancement include using yaw 

rate feedback and side-slip acceleration feedback control signals. The yaw rate of a 
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vehicle can be measured using a commercially available yaw rate sensor. The side- 
slip velocity of a vehicle can be measured using a side-slip velocity sensor, or 
sensors, which is currently very expensive. Instead of using a side-slip velocity 
sensor, side-slip acceleration can be estimated based on the lateral acceleration, yaw 
rate, and speed of a vehicle. Ideally, the side-slip velocity of a vehicle can be 
obtained by integrating the side-slip acceleration. However, since sensor bias exists 
in the signals associated with yaw rate sensors and lateral accelerometers, the 
integration tends to drift due to the integration of the unwanted bias signal. 
[0006] In one conventional approach, a vehicle stability enhancement system 

uses yaw rate feedback and side-slip angle feedback (which can be derived from 
side-slip velocity) to create a corrective yaw moment to enhance stability and 
improve the dynamic behavior of a vehicle. The estimation of side-slip velocity is 
implemented using a dynamic observer that captures the estimated state of dynamics 
of the vehicle. However, the estimation is based on the cornering compliances of 
the vehicle corners, which are variable vehicle parameters. The cornering 
compliances vary over a wide range and depend on a number of factors, including 
the type of surface that the vehicle is operating on. Therefore, the estimate of side- 
slip velocity is not as accurate as desired. 

[0007] In another approach, set forth in commonly-assigned, co-pending US 

Patent Application Serial No. 10/305,378 (Attorney Docket GP-301748) filed on 
November 26, 2002, which is hereby incorporated herein by reference in its 
entirety, a vehicle stability enhancement control system uses an open loop rear 
wheel steering angle command in combination with rear wheel yaw rate feedback 
and rear wheel side-slip rate feedback to create a corrective yaw moment to 
enhance stability and improve the dynamic behavior of a vehicle. 
[0008] In yet another approach set forth in commonly-assigned, co-pending 

US Patent Application Serial No. 10/404,371 (Attorney Docket GP-302466) filed on 
April 1, 2003, which is hereby incorporated herein by reference in its entirety, a 
vehicle stability enhancement control system includes a side-slip velocity estimation 
module. A side-slip acceleration estimation module determines an estimated side- 
slip acceleration of a vehicle. In the side slip acceleration module, a limited- 
frequency integrator integrates the estimated side-slip acceleration to determine an 
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estimated side-slip velocity of the vehicle. The estimated side-slip acceleration is 
determined based on a yaw rate, a lateral acceleration, and a speed of the vehicle. 
A reset logic module clears an output of the limited-frequency integrator when a 
first condition occurs. The first condition is a straight-driving condition that is 
determined based on a yaw rate, a lateral acceleration, and an angle of a steering 
wheel of the vehicle. The first condition is a speed condition that is based on a 
speed of the vehicle. The first condition is a sensor bias condition that is based on 
the estimated side-slip acceleration. The estimated side-slip velocity is compared to 
a desired side-slip velocity to produce a side-slip control signal. The side-slip 
control signal is combined with a yaw rate control signal to produce an actuator 
control signal. The actuator control signal is received by at least one brake actuator 
that applies a brake pressure difference across at least one axle of the vehicle to 
create a yaw moment to correct a dynamic behavior of the vehicle. The actuator 
control signal is received by a rear-wheel steering actuator that turns a set of rear 
wheels of the vehicle to create a yaw moment to enhance stability and improve the 
dynamic behavior of the vehicle. The limited-frequency integrator includes a 
feedback control loop. The accuracy of the integrator determines the accuracy of 
the side-slip velocity determined thereby, and hence, the accuracy and performance 
of the overall stability enhancement control system. The accuracy of the limited 
frequency integrator can be improved by improving the accuracy of the frequency 
cutoff associated therewith. 

[0009] Therefore, it is desirable to improve the accuracy of the frequency 

cutoff of the limited frequency integrator in order to improve the accuracy and 
performance, and hence the usefulness, of the integrator, and in turn to improve the 
performance of the vehicle stability enhancement control system which is based 
thereon. 

SUMMARY OF THE INVENTION 

[0010] A vehicle stability enhancement control system according to the 

present invention includes a side-slip velocity estimation module. A side-slip 
acceleration estimation module determines an estimated side-slip acceleration of a 
vehicle. A limited-frequency integrator integrates the estimated side-slip 
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acceleration to determine an estimated side-slip velocity of the vehicle. The limited- 
frequency integrator includes a feedback control loop which incorporates a cutoff 
frequency for the integrator. 

[0011] The estimated side-slip acceleration is determined based on a yaw 

rate, a lateral acceleration, and a speed of the vehicle. A reset logic module clears 
an output of the limited-frequency integrator when a first condition occurs. The 
first condition is a straight-driving condition that is determined based on a yaw rate, 
a lateral acceleration, and an angle of a steering wheel of the vehicle. The first 
condition is a speed condition that is based on a speed of the vehicle. The first 
condition is a sensor bias condition that is based on the estimated side-slip 
acceleration. 

[0012] The limited-frequency integrator includes a feedback loop which 

incorporates a cutoff frequency for the integrator. The cutoff frequency is 
determined using a Fast Fourier Transform (FFT) of the signal associated with the 
estimated side-slip acceleration. The cutoff frequency is preferably selected to be 
the minimum frequency content associated with the FFT. The cutoff frequency is 
preferably determined only for vehicle speeds that are above a speed threshold such 
that control of vehicle side-slip is a concern. A correction factor is also preferably 
applied to the derived cutoff frequency depending on the magnitude of the estimated 
side-slip acceleration. 

[0013] The estimated side-slip velocity is compared to a desired side-slip 

velocity to produce a side-slip control signal. The side-slip control signal is 
combined with a yaw rate control signal to produce an actuator control signal. The 
actuator control signal is received by at least one brake actuator that applies a brake 
pressure difference across at least one axle of the vehicle to create a yaw moment to 
improve stability and improve the dynamic behavior of the vehicle. The actuator 
control signal is received by a rear-wheel steering actuator that turns a set of rear 
wheels of the vehicle to create the yaw moment. 

[0014] Further areas of applicability of the present invention will become 

apparent from the detailed description provided hereinafter. It should be understood 
that the detailed description and specific examples, while indicating the preferred 
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embodiment of the invention, are intended for purposes of illustration only and are 
not intended to limit the scope of the invention. 

BRIEF DESCRIPTION OF THE DRAWINGS 

[0015] The present invention will become more fully understood from the 

detailed description and the accompanying drawings, wherein: 
[0016] FIG. 1 is a schematic illustration of a vehicle stability enhancement 

system with differential braking control and rear-wheel steering control; 
[0017] FIG. 2 is a functional block diagram of a vehicle stability 

enhancement control system; 

[0018] FIG. 3 is a functional block diagram of the side-slip velocity 

estimation module of FIG. 2; 

[0019] FIG. 4 is a functional block diagram of the side-slip acceleration 

estimation module of FIG. 3; 

[0020] FIG. 5 is a functional block diagram of the reset logic module of 

FIG. 3; 

[0021] FIG. 6 is a functional block diagram of the straight-driving condition 

module of FIG. 5; 

[0022] FIG. 7 is a functional block diagram of the integration module of 

FIG. 3; 

[0023] FIG. 8 is a functional block diagram of a limited-frequency integrator 

including a feedback loop; 

[0024] FIG. 9 is a flowchart illustrating the operation of the side-slip 

velocity feedback control and the calculation of the cutoff frequency which is used 
to establish the feedback gain; 

[0025] FIG. 10 is an exemplary plot of the estimated vehicle side-slip 

acceleration signal as a function of time with the presence of sensor bias; 
[0026] FIG. 1 1 is a plot of the FFT of the V y _dot signal versus time data of 

FIG. 10 illustrating the magnitude of the frequency component of this signal plotted 
in the frequency domain; and 

[0027] FIG. 12 is a plot of actual side-slip velocity, estimated side-slip 

velocity which did not incorporate the feedback control of the present invention and 
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estimated side-slip velocity incorporating the cutoff frequency based feedback 
control of the present invention as a function of time. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 
[0028] The following description of the preferred embodiment(s) is merely 

exemplary in nature and is in no way intended to limit the invention, its application, 
or uses. For purposes of clarity, the same reference numbers will be used in the 
drawings to identify similar elements. 

[0029] Referring to FIG. 1, an exemplary vehicle stability enhancement 

system is illustrated for a vehicle 10 with rear-wheel steering and differential 
braking. To implement differential braking, a controller 12 sends an actuator 
control signal 14 to a differential brake control module 16. The differential brake 
control module 16 sends a brake control signal 18 to one or more brake actuators 
20. The brake control signal 18 instructs the brake actuators 20 to create a brake 
pressure difference across at least one of the axles 22 of the vehicle 10. The brake 
pressure difference creates a yaw moment to correct a dynamic behavior of the 
vehicle 10 when there is a discrepancy between a desired yaw rate and actual yaw 
rate and/or a desired side-slip velocity and actual side-slip velocity of the vehicle 10. 
[0030] To implement rear-wheel steering, the controller 12 sends the 

actuator control signal 14 to a rear- wheel steering control module 24. The rear- 
wheel steering control module 24 sends a steering control signal 26 to a rear-wheel 
steering actuator 28. The rear-wheel steering actuator 28 turns a set of rear wheels 
30 of the vehicle 10 to create a yaw moment to correct the dynamic behavior of the 
vehicle 10. While the vehicle stability enhancement system of FIG. 1 implements 
both differential braking and rear- wheel steering, either system alone or other 
methods could be used for vehicle stability enhancement. 
[0031] Whether differential braking, rear-wheel steering, or both are 

implemented, the controller 12 receives information about the operating conditions 
of the vehicle 10 from several sensors. A steering wheel angle sensor 32 detects the 
position of a steering wheel 34 of the vehicle 10 and sends a steering wheel angle 
signal 36 to the controller 12. A speed sensor 38 detects the speed of the vehicle 10 
and sends a speed signal 40 to the controller 12. A lateral accelerometer 42 detects 
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the lateral acceleration of the vehicle 10 and sends a lateral acceleration signal 44 to 
the controller 12. A yaw rate sensor 46 detects the yaw rate of the vehicle 10 and 
sends a yaw rate signal 48 to the controller 12. While the controller 12 is shown as 
an independent element of the vehicle 10, it may be implemented as part of a 
computer of the vehicle 10. Additionally, the rear-wheel steering control module 24 
and the differential brake control module 16 may have independent controllers to 
process information collected from the sensors. The present invention may also be 
implemented as a feature that a driver could turn off. 

[0032] Referring now to FIG. 2, the controller 12 implements a vehicle 

stability enhancement control system 56 that includes a command interpreter module 
58, a yaw rate feedback module 60, a side-slip velocity estimation module 62, and a 
side-slip velocity feedback module 64. The command interpreter module 58 
generates a desired yaw rate signal 66 and a desired side-slip velocity signal 68 
based on the steering wheel angle signal 36 and the speed signal 40. If the values of 
the desired yaw rate signal 66 and/or the desired side-slip velocity signal 68 are 
surpassed by a predetermined threshold, it is likely the road conditions necessitate 
vehicle stability enhancement and a driver feels a loss of control of the vehicle 10. 
The predetermined threshold may be a function of the speed of the vehicle 10. 
[0033] The yaw rate feedback module 60 generates a yaw rate control signal 

70 by comparing the yaw rate signal 48 and the desired yaw rate signal 66. The 
side-slip velocity estimation module 62 generates an estimated side-slip velocity 
signal 72 based on the steering wheel angle signal 36, speed signal 40, and lateral 
acceleration signal 44. The side-slip velocity feedback module 64 generates a side- 
slip velocity control signal 74 by comparing the desired side-slip velocity signal 68 
and the estimated side-slip velocity signal 72. A summing node 76 combines the 
yaw rate control signal 70 and the side-slip velocity control signal 74 to generate the 
actuator control signal 14. The actuator control signal 14 instructs the differential 
brake control module 16, the rear- wheel steering control module 24, or both to 
create a corrective yaw moment to correct the dynamic behavior of the vehicle 10. 
[0034] Referring now to FIG. 3, the side-slip velocity estimation module 62 

includes a side-slip acceleration estimation module 78, an integration module 80, 
and a reset logic module 82. The side-slip acceleration estimation module 78 
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generates an estimated side-slip acceleration signal 84 based on the yaw rate signal 
48, lateral acceleration signal 44, and the speed signal 40. The estimated side-slip 
acceleration signal 84 is the integrand of the integration module 80. The integration 
module 80 integrates the estimated side-slip acceleration signal 84 to generate the 
estimated side-slip velocity signal 72. The reset logic module 82 generates a reset 
signal 86 based on the estimated side-slip acceleration signal 84, the lateral 
acceleration signal 44, the speed signal 40, and the steering wheel angle signal 36. 
[0035] The integration module 80 preferably includes a resettable limited- 

frequency integrator. A resettable integrator works like a typical integrator to 
accumulate the values of the integrand when a reset command is inactive (FALSE). 
The resultant integral is cleared to zero when the reset command is active (TRUE). 
A limited-frequency integrator has a limitation on its input frequency range. If the 
sensors used to estimate side-slip acceleration were ideal, there would be no need to 
reset the integrator or limit its input frequency range. Side-slip velocity is 
mathematically the integration of side-slip acceleration. However, practically all 
sensors have bias and/or drift as understood by those skilled in the art of vehicle 
controls. Without resetting the integrator or limiting its input frequency, the 
integrator would continue to accumulate the bias and/or drift, which reduces the 
accuracy of the signal. Ideally, the bias and/or drift components could be estimated 
and removed before the integration process. However, a bias and/or drift removal 
process would be very difficult. Although the bias and/or drift are not removed or 
blocked off completely when the reset command is inactive, the accumulation during 
such a limited period of time is not significant enough to cause adverse effects in the 
control system. Limiting the input frequency range reduces the effect of steady- 
state or near-steady-state bias and/or drift. 

[0036] The integration module 80 accepts the reset signal 86 and clears the 

estimated side-slip velocity signal 72 when the reset signal 86 is TRUE. The reset 
signal 86 is TRUE when the existing vehicle motion does not require vehicle 
stability enhancement. The estimated side-slip velocity signal 72 is the integral of 
the estimated side-slip acceleration signal 84 when the reset signal 86 is FALSE. 
The reset signal 86 is FALSE when the existing vehicle motion requires vehicle 
stability enhancement. 
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[0037] Referring now to FIG. 4, the side-slip acceleration estimation module 

78 is further illustrated. Side-slip acceleration is estimated based on the values of 
the yaw rate signal 48, the lateral acceleration signal 44, and the speed signal 40. In 
step 94, the controller 12 reads the current value of the yaw rate signal 48, lateral 
acceleration signal 44, and speed signal 40. In step 96, the estimated side-slip 
acceleration is calculated. The product of the yaw rate and speed is subtracted from 
the lateral acceleration. The result is the value of the estimated side-slip 
acceleration signal 84. 

[0038] Referring now to FIG. 5, the reset logic module 82 is further 

illustrated. In step 104, a timer is initialized and set to zero. Step 104 is preferably 
performed before the reset logic module 82 is executed for the first time after the 
vehicle 10 is turned on. In step 106, the controller 12 reads the current values of 
the estimated side-slip acceleration signal 84, the yaw rate signal 48, the speed 
signal 40, and the steering wheel angle signal 36. In step 108, the controller 12 
determines a straight-driving condition that indicates whether the vehicle 10 is 
turning or not. In step 110, the controller 12 proceeds to step 112 if the speed of 
the vehicle 10 is below a first threshold value or the straight-driving condition is 
TRUE. In step 1 12, the reset signal 86 is set to TRUE and the output of the 
integration module 80 is cleared. Following step 112, the controller 12 resets the 
timer to zero in step 114. The fact that the vehicle 10 is not turning and/or is 
traveling below a threshold speed, 10 miles per hour for example, indicates that 
there is no potential need for vehicle stability enhancement. 
[0039] If the speed of the vehicle 10 is above the first threshold and the 

straight-driving condition is FALSE, the controller 12 proceeds from step 110 to 
step 116. The fact that the vehicle 10 is turning and the speed is above a first 
threshold value indicates the potential need for vehicle stability enhancement. In 
step 116, the controller 12 proceeds to step 118 if the absolute value of the 
estimated side-slip acceleration is above a second threshold value. When the 
estimated side-slip acceleration is above the second threshold value, it is likely that 
the value of the estimated side-slip acceleration signal 84 is caused by genuine 
vehicle motion and not sensor bias or drift. In step 118, the timer is reset to zero 
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and the controller 12 proceeds to step 120. The reset signal 86 is set to FALSE and 
the output of the integration module 80 is the estimated side-slip velocity. 
[0040] If the absolute value of the estimated side-slip acceleration is below 

the second threshold, .02 g for example, the controller 12 proceeds to step 122. In 
step 122, the controller 12 proceeds to step 124 when the timer is below a third 
threshold value. Step 124 increments the timer and the controller 12 proceeds to 
step 126. The reset signal 86 is set to FALSE and the output of the integration 
module 80 is the estimated side-slip velocity. When the absolute value of the 
estimated side-slip acceleration is above the second threshold and the timer is above 
the third threshold, it is likely that the value of the estimated side-slip acceleration is 
actually caused by sensor bias and drift and not genuine vehicle motion. If the timer 
is above the third threshold, two seconds for example, the controller 12 proceeds to 
step 112. 

[0041] Referring now to FIG. 6, step 108 of FIG. 5 is further illustrated. In 

step 134, the controller 12 reads the current values from the yaw rate signal 48, the 
lateral acceleration signal 44, and the steering wheel angle signal 36. In step 136, 
the controller 12 proceeds to step 138 when the absolute value of the yaw rate is less 
than a first threshold, the absolute value of the lateral acceleration is below a second 
threshold, and the steering wheel angle is below a third threshold. Otherwise, the 
controller 12 proceeds to step 140. Step 138 sets the straight-driving condition to 
TRUE, and step 140 sets the straight-driving condition to FALSE. 
[0042] Referring now to FIG. 7, the integration module 80 is further 

illustrated. In step 148, the output of the integration module 80 is cleared. In step 
150, the internal states of the integration module 80 are cleared. Steps 148 and 150 
are preferably performed before the integration module 80 is executed for the first 
time after the vehicle 10 is turned on. In step 152, the current values of the 
estimated side-slip acceleration signal 84 and the reset signal 86 are input to the 
integration module 80. In step 154, the integration module 80 integrates the 
estimated side-slip acceleration. In step 156, the controller 12 proceeds to step 158 
when the reset signal 86 is set to TRUE. Step 158 clears the output and internal 
states of the integration module 80. Otherwise, the controller 12 proceeds from step 
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156 to step 160 when the reset signal 86 is FALSE. At step 160, the output of the 
integration module 80 is the value of the estimated side-slip velocity signal 72. 
[0043] Referring now to FIG. 8, step 154 of FIG. 7 is further illustrated. 

The input to the integration module 80 has a limit on its frequency range. This is to 
ensure that sensor bias or drift does not have a significant effect on the estimation of 
vehicle side-slip velocity. The sensor bias or drift is typically a steady-state or near- 
steady-state condition with a near-zero frequency. By continually feeding back an 
updated cutoff frequency designed and determined so as to cutoff frequencies 
associated with sensor bias or drift as the limit on the frequency range of the 
integration module 80, it is possible to maximize the integrated signal while at the 
same time minimizing sensor bias or drift in the integrated signal. 
[0044] Referring to FIGS. 8-12, an exemplary embodiment of a method of 

determining an appropriate cutoff frequency for the integration module 80 which 
includes a feedback loop is described. Referring to FIG. 8, a feedback gain 176 is 
multiplied by the integrator output signal 174 and offsets the input signal 170. The 
feedback gain 176 is chosen to be a frequency below which the integration of the 
input signal 170 is to be limited, as understood by those skilled in the art of system 
dynamics. When the frequency of the input signal 170 is significantly larger than 
the feedback gain 176, the limited-frequency integrator behaves like a standard 
integrator. When the frequency of the input signal 170 is below the feedback gain 
176, the limited-frequency integrator behaves like a process with a constant gain that 
is determined by the feedback gain 176. Therefore, signals due to sensor bias will 
not be integrated and will be limited to a component that is the product of the 
magnitude of the bias and the feedback gain. 

[0045] Referring to FIG. 2, as described herein, the side-slip velocity 

feedback module 64 generates a side-slip velocity control signal 74 by comparing 
the desired side-slip velocity signal 68 and the estimated side-slip velocity signal 72. 
It is preferred that side-slip velocity feedback module 64 generates a side-slip 
velocity control signal 74 in order to enable slip velocity feedback control by a 
comparison of the desired side-slip velocity signal 68 and the estimated side-slip 
velocity signal 72 which comprises an estimation of the side-slip error. The side- 
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slip error, Ev y , as determined in this process is an important element in the process 
of improving the side-slip velocity feedback control according to this invention. 
[0046] The side-slip velocity error ( E Vy ) may be determined by taking the 

difference of a desired side-slip velocity (V y desired ) and the actual side-slip velocity, 

or as described herein, an estimate of the side-slip velocity, such as feedback side- 
slip velocity (V y fee(ibark ), as illustrated in the following equation: 

Eyy = _ desired ~ _ feedback ( ^ ) 

[0047] The accuracy of the side-slip velocity error and thus the accuracy and 

usefulness of side-slip velocity feedback module 64 is dependent upon on an 
accurate measurement of actual vehicle side-slip velocity, such as feedback side-slip 
velocity {V yfeedback ) or, as described herein, on an accurate estimate of the side-slip 

velocity, as well as an accurate and representative value of the desired side-slip 
velocity (Vyjesired) . The desired side-slip velocity is preferably determined by a 
command interpreter as disclosed in commonly assigned U.S. Patent No. 
6,122,584, which is hereby incorporated herein by reference in its entirety. While 
determination of the actual side-slip velocity is desirable, a side-slip velocity sensor 
is generally very expensive and thus, not well suited to broad application in vehicles 
that are intended for high volume production. 

[0048] Since direct determination of the actual side-slip velocity is generally 

not technically or economically feasible in mass produced vehicles given the current 
state of the art with respect to side-slip velocity sensors and sensing methods, it is 
presently desirable to determine an estimate of the side-slip velocity. An estimate of 
the side-slip velocity (V y ) may be obtained by integration of the vehicle side-slip 

acceleration. Side-slip acceleration can be determined according to the relationship 
comprising: 



V y = Uy - r{V x ) + B = V y __ d + B , 



(2) 
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where: a y is the lateral acceleration, r is the yaw rate, V x is the vehicle speed, B is 
the sensor bias or drift, V v measure(t is the side-slip acceleration (or derivative of side 
slip velocity) that is calculated from the measured quantities noted above, and 
V v or V Ydot is the calculated side-slip acceleration. Since the sensor bias or drift is 

frequently difficult to characterize accurately, this calculation may also be generally 
characterized as an estimate of the side-slip acceleration. 

[0049] In a direct integration, the expression of the Laplace transform is: 



K(s) = -[V V „,,(*) + *(*)], 3) 



where: V v (s) is the estimated integration result, V ymeasured is the measured derivative 

signal, s is the representation of the complex variable associated with the Laplace 
transform and B(s) is the sensor bias. Since signals from sensors associated with the 

quantities used to determine V ymeasured generally contain bias and drift, a direct 

integration will cause the integration to accumulate the bias and drift and render 
inaccurate and undesirable results. Therefore, it is desirable to design an integration 
process with limited bandwidth so as to limit, or preferably to exclude, the sensor bias 
and drift from the integration results. 

[0050] A limited bandwidth integration may be accomplished according to 

the relationship comprising: 



(s + f r ) - t (4) 



where f c is the cutoff frequency of the integration and is selected so as to limit the 
effects of sensor bias and drift. Since V ymeasured may be expressed as : 

V y _ measured ( S ) = S _ measured ( S ) _ measured (^) 
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Assuming a zero initial condition, V measured ma Y be expressed as 

_ measured ( S ) ~ S ^y_ measured ( S ) 

and by substitution in equation (4) , V v (s) may be expressed as: 



C* + / t ) ' C* + /c) 



(6) 



(7) 



Therefore, the transfer function from input X m (s) to output V (s) , may be expressed 
according to the relationship comprising: 



Vy_measured ( S ~*~ /c ) (g) 



while the transfer function from the bias 5(5) to V (s) may be expressed according 
to the relationship comprising: 



SW (» + /,). (9) 



In order to minimize the overall error associated with the accuracy of integration and 
the effect of the bias, a cost function associated with bias and drift may be developed 
utilizing these transfer functions, and may be expressed according to the relationship 
comprising: 

J = w l [\G(j W )\-lf +w 2 \H(j W f 

1 



= w .( / 2 , -ir + vv 2 (- . 



(10) 
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where: vv is the system operating frequency under consideration, for example, the 
vehicle natural frequency at certain operating condition, and w, and w 2 are weighting 
factors for the cost function, wherein Wj + w 2 = 1. Then, the derivative of the cost 
function may be taken, according to the relationship comprising: 



dJ „ r w 1 vv 2 2w,w 
— = 2W, [ , - 1][ , - , 1 — 



,(11) 



In order to establish the minimum of the cost function, the equation may be solved for 
= 0. The result is a complex equation which may be solved for the cutoff 

dw 

frequency, f c , and expressed according to the general form comprising: 

f c =/(Wi,w 2 ,w) (12) 

[0051] A Fast Fourier Transform (FFT) of the signal associated with the 

side-slip acceleration is used to determine the frequency content of the side-slip 
acceleration. It is also preferred that a correction factor be applied to the derived 
cutoff frequency based on the magnitude of the side-slip acceleration. 
[0052] FIGS. 9-12 illustrate one embodiment of a method 200 for 

determining the cutoff frequency, f r , using the techniques described above and the 

associated output. Method 200 is preferably implemented using control logic in 
controller 12, such as control logic utilized in conjunction with side-slip velocity 
estimation module 62. Referring to FIGS. 3, 8 and 9, method 200 comprises a step 
of obtaining 205 the vehicle speed, V x , such as vehicle speed 40 and the vehicle 

side-slip velocity rate, V y or V v dol , such as side-slip velocity rate 170. Referring 

again to FIG. 9, method 200 also comprises a step of determining 210 whether the 
vehicle speed falls below a threshold speed, V th , for example about lOkph. The 

threshold speed varies as a function of the vehicle and its characteristics, the vehicle 
load, and roadway type and condition. 
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[0053] If the vehicle speed falls below the threshold speed, the method 200 

employs the step of setting 220 the cutoff frequency, f r , to a predetermined 

minimum frequency, / min , for example, 0.001 (generally speaking a number that is 
close to zero but not zero). This step avoids the need to perform additional signal 
processing, as described below, for vehicle speeds that result in negligible vehicle 
side-slip. The vehicle threshold speed is selected such that the side-slip velocity of 
the vehicle is negligible at vehicle speeds which are below the threshold. 
[0054] If the vehicle speed is greater than or equal to the vehicle speed 

threshold, method 200 employs a step of performing 230 FFT processing of the 
estimated side-slip acceleration signal 84, V y meosured , to determine its frequency 
content. FIGS. 10 and 1 1 illustrate the frequency content (see FIG. 12) of the time- 
based signal associated with V or V dot (see FIG. 10) which results from using 

FFT to transform the time-based signal to plot its frequency-based content or 
constituents. Such signal processing can be performed using a commercially 
available FFT processor based on well known digital signal processing (DSP) 
apparatus and methods. Such DSP methods and apparatus may be incorporated into 
controller 12 in the form of associated software and hardware or may comprise a 
separate FFT control module that is in signal communication with controller 12. 
FIG. 10 shows an example of the time trace 244 of V y or V y dot , and FIG. 11 shows 

an example of the frequency-based transform of the signal shown in FIG. 10 
performed using the FFT method and apparatus. 

[0055] Method 200 also includes a step of identifying 240 the minimum 

value of the frequency content 242 from the FFT, for example 0.12 Hz, as 
illustrated in FIG. 11. This minimum may also be determined using known signal 
analysis apparatus and methods. Once the minimum has been identified, method 
200 also comprises a step of setting 250 the cutoff frequency equal to the minimum 
value of the frequency content, / min c . 

[0056] Method 200 also includes a step of determining 260 whether the 

absolute value or magnitude of the estimated vehicle side-slip acceleration, V y _dot, is 
less than a predetermined side-slip acceleration threshold, V y _dot_th , for example 
1 m/s 2 . This test is utilized to adjust the value of the cutoff frequency in the case of 
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excessive side-slip acceleration. If the absolute value of the estimated side-slip 
acceleration is greater than the predetermined side-slip acceleration threshold, for 
example 1 m/sec 2 , method 200 also includes a step of factoring 270 the cutoff 
frequency using a frequency correction factor, C v , or gain to reduce the value of 

the cutoff frequency and account for the effect of excessive side-slip acceleration, 
and method 200 continues to block 280 described below. C v is determined 

empirically based on the magnitude of the side-slip acceleration. The frequency 
correction factor may be stored in a look-up table within the controller 12, as shown 
in the examples provided in Table 1 . 

Table 1: C v as a Function of V y (iol 



2 

Side-Slip Acceleration (m/s ) 


1 


3 


5 


7 


10 


Frequency Correction Factor 


1 


0.7 


0.1 


0.05 


0.01 



If the estimated side-slip acceleration is less than or equal to the predetermined side- 
slip acceleration threshold, the cutoff frequency is unaffected, and remains equal to 
the minimum value of the frequency content, f^ n c , and method 200 continues to 

step 280. 

[0057] Method 200 includes an additional step of determining 280 whether 

the value of the cutoff frequency, either following the application of the correction 
factor in step 260 or as established in step 250, is less than the minimum value of 
the frequency content. This is essentially a test of whether the value of the 
frequency correction factor is less than one. If the value of the correction factor is 
less than one, the cutoff frequency is determined 290 to be the product of the 
correction factor and the minimum value of the frequency content. If the value of 
the frequency correction factor is greater than or equal to one, no correction factor 
is applied and the value of the cutoff frequency remains equal to the minimum value 
of the frequency content, f^ n c . 

[0058] Referring now to FIG. 12, the effect of side-slip velocity estimation 

is illustrated with and without the presence of sensor bias and drift. The estimated 
side slip velocity obtained using a fixed cutoff frequency as a function of time is 
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shown in time trace 500. As may be seen, while providing a very useful estimate, it 
has a tendency to overestimate the side slip velocity in the example provided as 
compared to the actual side-slip velocity shown as a function of time in time trace 
520, due to the influence of sensor bias and drift. The actual side-slip velocity was 
measured by instrumenting a vehicle with a commercially available side-slip velocity 
sensor. The estimated side-slip velocity obtained using the adaptive cutoff 
frequency according to the present invention as a function of time is shown in time 
trace 510. As may be readily seen, the estimated side-slip velocity according to the 
present invention compares quite closely to the actual side-slip velocity owing to the 
reduction of the effects of sensor bias and drift. 

[0059] The present invention provides for improved vehicle stability 

enhancement including a more accurate estimation of vehicle side-slip velocity. 
This is achieved with little software overhead and without additional hardware costs 
over and above the existing state-of-the-art stability enhancement systems. 
[0060] Those skilled in the art can now appreciate from the foregoing 

description that the broad teachings of the present invention can be implemented in a 
variety of forms. Therefore, while this invention has been described in connection 
with particular examples thereof, the true scope of the invention should not be so 
limited since other modifications will become apparent to the skilled practitioner 
upon a study of the drawings, specification, and the following claims. 



